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摘要 ， 车 载 动 基 座 下 车 辆 轮胎 、 悬 架 部 分 的 弹性 变形 在 快速 伺服 控制 系统 中 会 起 
到 一 定 的 扰动 作用 ， 本 文通 过 分 析 车 体 扰动 对 电机 控制 系统 的 影响 ， 确 定 了 解决 动 基 
座 电 机 伺服 系 乡 A ert td tap 
根据 扰动 数据 结果 设计 低 通 滤波 器 和 伺服 控制 策略 ， 以 某 型 安装 在 动 基 座 上 的 电机 伺 
pa! 了 伺服 系统 的 仿真 ， 并 将 以 上 研究 成 果 在 该 系统 中 进行 了 应 用 。 该 伺 
服 系统 最 终 的 试验 结果 表明 ， 本 文中 裁 车 底盘 频率 的 测量 结果 、 设 计 的 滤波 器 和 伺服 
控制 策 有 有 站 由 覆 他 | 体 天 动 汪 交流 全 及 电 宙 抽 及 用， 控制 精度 满足 系统 要 求 。 

关键 词 ， 车 载 动 基 座 ”车 体 扰动 ”交流 电机 ”人 向 服 控 制 系 统 

中 图 分 类 号 : TM383.4 


Servomotor’s Control Research and Application on 
Vehicle-Mounted Moving Base 


LiAiping Jiang Xiaomineg LiJiasheng 
( The 8th Institute of Shanghai Academy of Spaceflight Technology 
Shanghai 210109 China) 


Abstract: On vehicle-mounted moving base, the vehicle tire and suspension’s 
elastic deformation will play a role in disturbances in rapid servo control system. Through 
the analysis of the influence of vehicle disturbance for motor control system, this article 
determines the key technology of high precision servo system on the moving base is to 
measure the cars chassis suspension system natural vibration frequency, according to the 
result of the disturbance data to design low-pass filter and servo control strategy, and the 
simulation of the servo System 1s also carried out. In the end, as an example, the above 
research results are applied to a certain motor servo system installed on moving base. 
The final test results show that the servo system in this paper, the filter and effectively 
suppresses the bodywork disturbance servo control strategy for ac servo motor, the 
influence of control precision meet the system requirements. 
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1 引言 


为 有 效应 对 精确 打击 和 低空 / 超 低 空 突 防 威胁 ， 
武器 系统 对 快速 反应 能 力 和 自我 生存 能 力 提出 了 更 
高 的 要 求 ， 以 便 在 行进 过 程 中 及 时 把 握 战机 ， 快 速 
拦截 来 袭 目 标 。 为 了 满足 上 述 要 求 ， 具 备 短 停 稳 瞄 
能 力 乃 至 于 具备 行进 间 高 精度 控制 能 力 就 成 了 末端 
防空 武器 所 必须 具备 的 能 

随 着 现代 机 械 化 水 平 的 发 展 ， 目 标的 机 动 性 达 
到 了 一 个 新 的 高 度 ， 对 稳定 跟踪 设备 的 性 能 提出 了 
更 高 的 要 求 "“"。 为 了 满足 短 停 运 行 及 行进 间 高 精度 
控制 的 需求 ， 车 辆 底盘 无 法 安装 调 平 系统 ， 这 就 带 
来 了 一 个 问题 ,车辆 轮胎 、 专 架 部 分 的 弹性 变形 在 
快速 伺服 控制 中 会 起 到 一 定 的 扰动 作用 。 在 船用 电 
机 伺服 系统 中 同样 面临 相同 的 问题 ， 但 是 由 于 波浪 
频率 低 ， 对 波浪 扰动 的 抑制 相对 容易 ， 且 国内 已 有 
多 型 成 功 案 例 。 车 体 扰动 由 于 高 频 成 分 较 多 ， 抑 制 
车 体 扰动 的 难度 更 大 。 

传统 的 车 载 伺 服 系 统 由 于 精度 要 求 低 ， 在 控制 
过 程 中 没有 考虑 底盘 的 弹性 变形 对 伺服 精度 产生 的 
影响 。 目 前 国内 有 多 家 单位 都 在 开展 短 停 及 行进 间 
高 精度 电机 控制 系统 的 研究 ， 但 控制 效果 均 不 理想 ， 
大 部 分 伺服 系统 的 控制 精度 都 在 0.3” 以 上 。 

某 项 目 由 于 甚 系统 的 特殊 性 ， 对 电机 何 服 系统 
的 精度 要 求 达到 了 0.15"。 该 项 目的 伺服 系统 在 调转 
过 程 中 ， 底 盘 的 姿态 变化 值 可 以 达到 0.2*， 如 果 不 
对 底盘 的 弹性 变形 带 来 的 扰动 进行 补偿 ， 何 服 精度 
无 法 满足 系统 要 求 ， 而 且 ， 如 果 没 有 在 伺服 控制 中 
有 效 避 开车 体 的 固有 频率 ， 还 有 可 能 会 出 现 伺 服 系 
统 与 车 体 的 谐振 现象 。 因 此 ， 对 载 车 底盘 自身 悬挂 
系统 刚度 及 阻尼 下 的 模 态 振 型 和 固有 振动 频率 进行 
测试 、 采 集 伺服 系统 运转 过 程 中 的 车 体 姿态 数据 并 
寻找 合适 的 滤波 方法 、 选 择 适当 的 伺服 控制 策略 并 
对 滤波 之 后 的 数据 进行 补偿 就 成 了 解决 动 基 座 伺服 
系统 高 精度 要 求 的 关键 技术 “1。 

本 文通 过 分 析 车 体 扰动 对 电机 伺服 系统 的 影响 ， 
确定 需要 首先 测量 出 车 体 基 挂 及 轮胎 的 固有 频率 ， 
以 便 在 控制 时 避 开 车 体 的 固有 频带 ， 根 据 车 体 的 振 
动 频 率 ， 选 择 了 巴特 沃 斯 滤波 器 作为 该 系统 的 低 通 
滤波 器 ， 确 定 了 融合 经 典 控制 理论 中 的 前 馈 控制 和 
模糊 参数 自 整定 的 复合 控制 算法 作为 该 系统 的 伺服 
控制 策略 ， 并 对 控制 系统 进行 了 仿真 。 最 终 ， 以 上 
研究 成 果 被 应 用 到 了 某 车 载 电机 伺服 控制 系统 中 ， 
系统 的 试验 结果 表明 ， 车 体 扰动 得 到 了 有 效 的 抑制 ， 
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电机 伺服 系统 运行 平稳 ， 静 态 误差 及 动态 跟踪 效果 
并 足 整体 控制 系统 要 求 。 


2 车 体 扰动 及 固有 频率 的 研究 分 析 


车 载 动 基 座 的 扰动 会 给 伺服 系统 的 控制 带 来 一 
定 的 影响 ， 因 此 ， 需 要 分 析 该 扰动 对 伺服 控制 的 影 
响 ， 并 重点 研究 车 体 固有 频率 在 其 中 起 到 的 作用 。 
2.1 车 体 扰动 对 伺服 系统 的 影响 

电机 伺服 系统 的 控制 原理 是 将 目标 指令 和 当 
前 位 置 乙 间 的 误差 作为 输入 ， 通 过 智能 控制 算法 
计算 控制 量 ， 进 而 控制 被 控 对 象 的 运动 。 对 于 安 
装 于 车 载 动 基 座 之 上 的 伺服 系统 ， 目 标 指令 都 加 
入 了 车 体 姿 态 的 变化 值 ， 具 体 的 做 法 是 : 载 车 的 底 
盘 上 安装 有 定位 定向 设备 ， 实 时 采集 车 体 在 偏 航 、 
俯仰 及 横 滚 方面 的 信息 ， 火 控 系 统 将 以 上 三 维 信 
息 转 换 为 伺服 系统 高 低 及 方位 两 个 方向 的 信息 加 入 
到 目标 指令 中 发 送 给 伺服 系统 。 目 标 指 令 中 的 高 频 


扰动 部 分 对 伺服 系统 的 控制 带 来 一 定 的 影响 。 甚 影 
响 具 体 表现 为 : 


(1) 装置 起 动 和 停止 的 瞬间 ， 由 于 采用 轮胎 结 
构 ， 底 盘 成 为 一 个 弹性 底座 ， 装 置 运转 的 动能 难 
以 迅速 消减 。 安 装 在 固定 平台 上 的 伺服 系统 ， 其 
动能 的 变化 能 够 迅速 通过 固定 的 底座 衰减 掉 ， 而 
由 于 车 载 基 座 的 弹性 特征 ， 动 能 的 变化 势必 引起 
轮胎 和 熙 架 的 振动 ， 需 要 较 长 时 间 才 能 将 动能 豪 
减 到 位 。 

(2) 由 于 底盘 本 身 存在 固有 频率 ， 伺服 系 统 的 
谐振 频率 会 因 底 座 动力 学 特性 的 变化 而 下 降 ， 这 就 
使 得 伺服 带宽 降低 ， 从 而 伺服 系统 对 于 高 频 扰动 的 
控制 力 下 降 。 

以 上 各 影响 均 需 要 首先 测量 出 车 体 悬 挂 及 轮胎 
的 固有 频率 并 加 以 分 析 ， 以 便 在 控制 时 避 开 车 体 的 
固有 频带 ， 进 而 获得 较 好 的 控制 效果 。 

2.2 车 体 固有 频率 测量 及 分 析 

在 底盘 大 梁 的 前 后 设置 了 4 个 测试 点 ， 在 测 
试点 上 分 别 安装 加 速度 传感器 ， 通 过 路 障 跌 落 的 方 
式 对 车 体 的 频率 进行 了 测试 ， 测 试 结果 如 图 1 所 
示 。 经 分 析 得 到 : 车 体 悬 挂 系统 自身 弹簧 阻尼 的 
一 阶 振动 频率 为 2.41Hz， 其 余 频 率 的 振动 为 悬 架 
结构 和 大 梁 结 构 的 前 六 阶 固有 振动 频率 ， 分别 为 
6.78Hz、12.70Hz、38.84Hz、54.42Hz、77.64Hz 以 
及 108.5Hz。 这 些 频 率 的 测量 结果 可 直接 用 于 指导 
伺服 系统 控制 带宽 的 设计 。 


201903.00065v1 


chinaXiv 


图 1 车 体 固有 频率 测试 结果 图 


Fig.l The measuring diagram for vehicle s fxed frequency 


3 ”针对 车 体 扰动 数据 的 滤波 算法 研究 


在 获取 了 车 体 的 固有 频率 之 后 即 确定 了 何 服 系 
统 运转 过 程 中 车 体 姿态 数据 滤波 的 截止 频率 。 接 下 
来 就 要 确定 合适 的 滤波 算法 。 

在 低 通 滤波 器 算法 的 选择 方面 ， 卡 尔 曼 滤波 器 、 
切 比 雪夫 渡 波 器 和 巴特 沃 斯 滤波 器 等 常用 的 滤波 器 
都 可 以 作为 软件 滤波 器 进行 使 用 。 卡 尔 曼 滤波 器 最 
初 的 形式 为 简单 卡尔 曼 滤 波 器 ， 现 在 已 经 改进 ， 提 
出 了 施 密 特 扩展 滤波 器 、 平 方 根 滤 波 器 等 多 种 改进 
形式 ， 这 类 滤波 器 利用 线性 系统 状态 方程 ， 通 过 系 
统 输入 输出 观测 数据 ， 对 系统 状态 进行 最 优 估计 。 
但 是 卡尔 曼 滤 波 器 计算 量 较 大 ， 适 合 在 离线 状态 下 
分 析 系 统 状 态 并 进行 估计 ; 切 比 雪夫 滤波 器 在 通 带 
或 阻 带 上 频率 响应 幅度 等 波动 信息 ， 与 理想 滤波 器 
的 频率 响应 曲线 之 间 的 误差 较 小 ， 但 在 仿真 之 后 发 
现 灌 后 明显 ;巴特 沃 斯 滤波 器 的 特点 是 通 频 带 内 的 
频率 响应 曲线 最 大 限度 平滑 ， 没 有 起 伏 ， 而 在 阻 频 
带 则 逐渐 下 降 为 零 ， 比 较 适 合 本 系统 的 情况 ， 因 此 ， 
最 终 选 择 巴特 沃 斯 滤波 器 作为 低 通 滤波 器 算法 ， 以 
谐振 频率 2Hz 作为 分 界 点 ， 对 伺服 软件 接收 到 的 目 
标 数 进行 滤波 ， 滤 除 车 体 姿 态 信 息 中 的 高 频数 据 分 
量 ,， 仅 对 低频 数据 进行 补偿 控制 ， 以 避免 谐振 对 系 
统 的 共振 影响 。 

在 本 系统 中 设计 了 四 阶 巴 特 沃 斯 滤波 器 ， 采 用 
如 下 的 表达 形式 对 数据 进行 了 仿真 


0.002 235(z+1)° 


GO- 一 一 
(22-1.213z+0.384)(z2 -1.48z+0.6887) 


高 低 及 方位 方向 上 的 扰动 滤波 前 后 的 效果 如 图 
2 和 图 3 所 示 ， 低 通 滤 波 效 果 明 显 。 

以 滤波 后 的 数据 作为 伺服 控制 算法 的 输入 指令 ， 
可 以 大 大 减少 高 频 成 分 对 伺服 控制 效果 的 影响 ， 使 
得 伺服 系统 仅 对 低频 数据 进行 补偿 控制 ， 可 以 在 一 
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高 低 向 扰动 /(”) 


高 


0 5 10 15 20 


图 2 高 低 向 扰动 滤波 前 后 的 效果 图 
Fig.2 The effect picture on elevation before and after 


adopting filter arithmetic 


方位 向 扰动 /) 
| 
2 
SN 


0 5 10 15 20 
1t/s 
图 3 方位 向 扰动 滤波 前 后 的 效果 图 
Fig.3 The effect picture on athemath before and after 


adopting filter azimuth 
定 程度 上 避免 谐振 对 系统 的 共振 影响 。 
4 ”电机 伺服 控制 策略 的 确定 及 仿真 结果 


根据 对 扰动 数据 精度 要 求 的 分 析 ， 采 用 了 融合 
经 典 控制 理论 中 的 前 馈 控 制 和 模糊 参数 自 整定 的 复 
合 控 制 算法 作为 系统 的 伺服 控制 策略 ， 并 在 Matlab 
软件 中 选用 交流 电机 模型 建立 了 一 套 仿真 模型 结构 ， 
以 滤波 后 的 数据 作为 输入 指令 进行 了 仿真 计算 。 具 
体 基 本 仿真 结构 图 如 图 4 所 示 。 

仿真 结果 如 图 5 和 图 6 所 示 (由 于 篇 幅 的 原因 ， 
本 文 只 列 出 方位 仿真 结果 )， 在 正常 跟踪 后 ， 正 纺 跟 
踪 误 差 及 等 速 跟踪 误差 仿真 结果 均 在 0.1° 以 内 。 方 
位 等 速 跟踪 曲线 如 图 7 所 示 。 


5 伺服 系统 具体 设计 


根据 车 体 频率 的 测试 结果 、 数 据 滤 波及 算法 仿 
真 效果 ， 开 展 了 某 型 伺服 系统 的 具体 设计 。 

伺服 系统 由 PowerPC 控制 器 、 信 号 控制 单元 、 
电机 、 电 机 驱动 器 、 位 置 采集 传感器 、 装 置 安全 机 
构 及 控制 软件 组 成 ， 控 制 对 象 为 某 发 射 装置 ， 而 装 
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图 4 ” Matlab 搭建 的 电机 伺服 系统 仿真 结构 图 


Fig.4 Servo-control structure diagram in Matlab 
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Fig.3 Sine tracking simulation curve for elevation 
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Fig.6 Sine tracking Simulation curve for azimuth 


置 安装 在 载 车 底盘 上 。 载 车 底盘 上 安装 有 定位 定向 
0 可 以 实时 地 采集 车 体 姿 态 信 息 。 火 控 系 统 将 
ea ta el 信息 ， 
pa 寸 CAN 通信 接口 接收 火 控 系统 
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图 7 方位 等 速 跟 踪 曲 线 

Fig.7 Constant speed tracking simulation curve for azimuth 
发 送 过 来 的 指令 信息 后 进行 巴特 沃 斯 滤波 ， 同 时 接 
收 电机 伺服 系统 的 位 置信 息 ， 并 根据 指令 及 位 置信 
息 对 控制 量 进行 计算 ， 方 位 及 高 低位 置 传感器 通过 
CAN 通信 接口 与 控制 器 进行 通信 ， 传 输 伺服 系统 的 
位 置信 息 ， 伺 服 控制 软件 中 采用 了 智能 控制 算法 ， 
通过 PowerPC 控制 器 进行 软件 运行 及 控制 量 计算 
| 
电机 进行 转动 ， 信 和 号 检测 单元 用 于 对 该 装置 的 限 位 
等 安全 信号 进行 采集 ， 为 控制 软件 的 安全 性 设计 提 
供 数据 来 源 。 伺 服 系统 总 体 框图 如 图 8 所 示 。 

在 伺服 控制 软件 中 按照 四 阶 巴 特 沃 斯 滤波 器 
的 表达 形式 对 接收 到 的 火 控 指令 进行 了 滤波 ， 滤波 
效果 与 仿真 效果 相近 ， 起 到 了 明显 的 高 频 扰动 抑制 
作用 。 

同时 ， 为 了 解决 伺服 系统 动能 的 变化 会 引起 轮 
胎 和 蕉 架 的 振动 进而 需要 较 长 时 间 才 能 将 动能 衰减 
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a ee 到 位 的 问题 ， 将 电流 环 及 控制 算法 中 的 参数 进行 了 
2 | =) Eo i lS 过 
下 健生 优化 ,采取 了 加 长 电机 的 加 减速 时 间 、 增 大 积分 党 
下 AN 通信 方便 全 数 、 将 控制 量 进行 平滑 处 理 等 措施 来 完善 伺服 系统 
2 因 CAN 通 信 高 低位 置 传感器 的 控制 效果 。 
We 6 伺服 系统 试验 验证 效果 
空 制 信号 电机 方位 6 条 < ] NY ] 正 交 

a 器 “| 电机 元 二 十 权 1 
转换 析 Ee 经 过 前 期 的 调试 ， 伺 服 系统 的 运行 效果 最 终 满 
2 足 了 系统 的 要 求 ， 其 静态 精度 为 0.05*， 动 态 跟踪 精 
8 ”伺服 系统 总 体 框图 度 达到 了 0.15"， 满 足 整体 系统 对 于 短 停 精确 控制 的 
Fig.8 General diagram for servo-control System 要 求 。 9 和 图 10 是 伺服 系统 在 进行 正弦 运动 及 等 


速 运 动 时 的 波形 效果 图 。 


角度 /0) 


性 1000 2000 3 000 4000 $000 6 000 7 000 8 000 9000 10000 11000 12000 13000 14 000 
时 间 /ms 


图 9 方位 向 正弦 运行 波形 图 


Fig.9 Sine tracking curve for elevation 


一 火 摊 数据 
一 伺服 数据 


角度 /0) 


200 400 600 800 1 000 1200 1400 1600 1800 2000 2200 2400 2600 2800 3000 3200 
时 间 /ms 


10 方位 向 等 速 运行 波形 图 


Fig.10 Constant Speed tracking curve for azimuth 


201903.00065v1 


chinaXiv 


本 文通 过 分 析 车 体 扰动 对 电机 伺服 系统 的 影响 ， 
确定 了 解决 车 载 动 基 座高 精度 电机 控制 系统 的 关键 
技术 ， 即 测量 车 体 悬 挂 及 轮胎 的 固有 频率 、 设 计 滤 
波 算法 和 伺服 控制 策略 ， 针 对 以 上 3 个 关键 要 素 开 
展 了 相关 的 测量 、 研 究 及 试验 ， 以 上 研究 成 果 最 终 
被 应 用 到 了 某 车 载 电机 伺服 控制 系统 中 。 该 系统 的 
试验 结果 表明 ， 本 文中 的 滤波 器 和 伺服 控制 策略 有 
效 地 抑制 了 车 体 扰动 对 电机 系统 带 来 的 影响 ， 电 机 
伺服 控制 精度 满足 系统 要 求 。 本 文 的 研究 成 果 对 于 
行进 间 高 精度 伺服 系统 的 最 终 实 现 具 有 较 强 的 借鉴 


意义 。 
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